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oflqnflojvg, ^ ^ Tfl^ * CAD/CAM 0 ^ AV-g-sl^ 2 *>€ ^4 ^ 

#*<H ^ #31, * nHM^S-^-El c-space obstacle^ ^Tfl^ 7fl^§> 

£ 2 

^4 ^S, CAD/CAM, ^^Ei ^-2fl^^ ( ofli-HH^, H o v ^l£ 
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2^]-^ ^5. ^yj-i* {METHOD FOR GENERATION OF 2-DIMENSIONAL MOTION PATH} 

^ 3^ ^ ^oll ^ ^ ^ ^# ^ ^H^, 

5L 5^ ^ ^/^ ^.H^l ^a] ^Aj 10 j 

* ^«.«-ol) cflfV if so] Ajrg * 

10: #°o^^^l 20: ^7l<^^] 

30: ^.2:71^^-^ 40: <y 1^*1 

50: 
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sls., ^Ml*>7fl^ 2*H1 A <MH 4°lt #1- Si^l ^-*M°>*Hir 2*V€ -g-^ ^s. ^ 

configurat ion-space obstacle(5£^, c-space obstacle)^: ^^s}^- y 0 v ^°fl ^t!: 
<i2> <^a>^ 0.5. c-space obstacle^: ^ 7}*}^ °}^°\] Er7] *}o} ^ip^OS S^Dom- 

A. 

<is> ^o^ ( ^-ofl^- A <4 ^ b^I cfl*}: c-space obstacle^ luf ^-o] 

<14> [^*}-^ i] TRJMidA. * d( — B))=-d(A ® {- 8)) =dP otd 

^^0 S ^ ov^^ olcf. loflAi -Bfe. #^1# ^ -Al 0_^_ 180£ 5l 

<16> ZL^C-ll, ^ ^ofl^ ^-f-^, TRIM, ^ "JifLH^l *fl-f ^^VoH 
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<18> [^tV^l 2] TRimidA £ * <?(-B)) c )=<?(A 0(-S))=dP s 

<19> §>^] °]- , ^"^r ^ 9^ 4 t^S^- €"1:^-^ ^^14 tj-S. Hj-^ 0.5. 



<20> ^o. A o V 7 l ^ ^Hfl g-Xl^* M*>7l ^ ^ilS.^, ^ S-^o. 2 ^ 7 1§> 

371 7}- £*Hr s^^-g. Jl^-^ ^*Kr 2*H1 *)1 

1#4 cflsfl zl-2} Hj-^1^1- ig^SHr Xl 2^-711; #7] ^-^ol 37 l # 

^ ^SH^l ^^Kr X] 3^-711; ^-71 XI 2#7jHH zl-zl-01 

W^t «M>H af^ 3.71 ^SRr XI 4#7}1; 
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A oM 4#7]HH ^^fl^l ^^Hl tfl«fl^ ^-^d^l^l- frfjl, £ «3 ^-JL, E^nl o^a}. 

^ 37l7> cf^ ^-ofl^- ^ ^-^ofl cflsflA^ c-space obstacle* 7fl^*Rr *1 6^7fl;* S^Rir 

-& 2*}Q ^-4 ^s. ^#^1 ^lll-^] c-space 

obstacle^ 7l^^o] ^ °- o]-g-^ o]^^ ^5Lis\x\ Qm, ifl^- 

9\- 2]*- ^^j^ # ^ 37lol ] tflaflAi O.JL ^-^s.* - oicf. 



%^}#, ^^fBi *)H^ ^^^^(lO)^, ^d^«8i i££L 

*V 5-€- 31^7} tI^^H 9X^ ^71^^(20)^, ^7) f^sH^l^l *\}o]6\] oj-e}. ^cfl 

o]B\7\ 7-^V ^ #^5]^ ^.2:71^^-^1(30)^, ^7}^ ^ ^ 5^*1 

(10)0)1 ^*M- *$%X\7}7] ^^^1(40) ^ 2)-^^Efl» SAl^ #1^*1(50)5. ^£ 

BIS i^-lr ^ $J1- 71^-iMofl 71^-51^, 71^-nfl^ofl T^S} £12^ ^E^cMH 
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£°§^-CL5.*) ^^^1(40)1- J§-n <$^& 2*}#2) 7l^£^oll tflsfl w 0 V^] £1 . ol-g-s]-^ #3] 
o) vflJf $]*o) ^-^^ ^X\6\] ^^^>j7 t a7 ] 7> ^0.0) 



y oHM^l- ^SHr *ll 2#7fl; ^71 ^<>|]#4 #*fl^ H711- ^ ^]SH>i7l 

^*Hr *11 3^31; ^-71 *f| 2#3HH ^-ofl^4 zj-z}-^ Hj-^^-g. ,3^. «J-%1= 
*]£ofl tflsiH ^iL*l iLf^ H7lS^ ^*3*Rr 4^:7^1 ; #7} 4&7\M*\ ^*fl# 

tfltflAi c-space obstacle^: 7fl^*}^r ^ 6#7fl ;# i^cf. 
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<30> °4^}S., ^n^Sr <Q&2] <S^fiLS 91%^ ¥ ^l^£r & 

ol^-cf. cfZ^ ^Tfl^ M-Ef^^ ^^-7]- 0>^ a)] AlTj]^ 7> 

<31> c^ig ^Tfl^ofl o o >^ £ ^ o^o} tiJ-^Eii?. o^o^ olcf. U^B] <*<^ 

<32> r _ 

<33> TDC S7l^- ^*fl 4^ ^-o] 4^- oHtM}. 

<34> 4 ] TDC=TRIM-nM- i °CC 

<35> ^-71 ^*Vai 41- DM-^ w o >^^5Ll- ^#*Rr ^^1^, 

TRIM& ^n^} €^ll*Hr 7-}7)M*} ^-9] *ll?l*Hr ^"fr ^nl^-Cj-. 

<36> n ^o^l yj-^JSL^ ^ ^ ^Aj-ofl cfltV ^Hlt!: ^-g-^ ^-^^^ ^-^ol o>u|ji 
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<38> d{A 0 eA0 

= TRJMidA o * 6L4 L ) 
= Ti>C(Z) 0 y 

= toccgscdoW J>i. i.D) 

[<5*«M 5] = TIXKGSi£> s , 1,1)). 

<40> 

9U o 0(-^l)) 

= TRIM( (dA. § *6»(-A L ) c ) 

= Ti)C((i) 0 c Ltl 

= TDCCGSCDoW .-Di, 1,-1)) 

™ 6] = TDC(GS(B s ,l,-l)). 

^*VA1 5^ 6 o. ^^Tg _ nl^n^ ^oij. Msgg. s.o^ ygig a o V^] £ A>-g- 
«H ^ ^-§-^T ° S V ^ SU^h ^1"^ 3.7} ^ <£*HH «oH>^E^ «j-^n> t.}^ 

^JfE^ w o V^«flEi!-ofl -l£ tg-^g. tiVcflS. *}%^. 

<43> ^ Sj-Tjl^- ^ ^ sfcxj S-^-s>^ , « 0 >^l£2f ^]S^^7l ^^ofl^ cf^-o) 

7] t.dc(gscd s , 1,1)) =au 0 ®^i), 
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<44> 



<45> 



<46> 
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[-^i 8] TDaGSiD =d(A 0 G-AO, 

9] TDC(GS(D S , -1,1)) =9U L 0-A o ), 

10] TnCiGS(D s , -1,-1)) =5(-A 0 e-^i). 



<48> n 
'r'H 7 ^*1 10* ^-S^, ^ ^^#-8: -E.^- ^^ y oHM£ 

Cfl*fl^ 31 ^ XI^ 1-11 7^ <£*)r-2r T*H 7°lH <#^o]] 

-1* ^-^^ 10°1 ^cf. sal- ^r*H4 9 ^TlMcj-. ziei^S. =r«M 7 

<49> 70. # ^ .A L o] ^-ofl # ^o] <2}J=Lo(|^ ^t-^W ^ -§-21°^ ^ -§-3- 3 

S.« ^Dl*lcf. ^, ~A l0 ] o] ^Tjl^-g- -a-^ol^ ^-ofl^-jz}- ^#*>tf. 

5l*l*>c]-. ^, ol A lo] ^^l^o. ^ ^ojig ^ofl^-il- ^l-^lcf. 

<si> ^ ^Tfll- ^el^M S^^, ^til^O-S. u o v ^l-£^- ^iaH^l <^^1^ t},g- 

21 11 i41*l 144 ^:7fl7> ^-g-* <£ ^ ^cf. o^7l A-i J D^=- J D 0 U J D l ^ 

<52> n] TnC(GS(D d , 1,1)) =3(- J 4 0 ©^ 1 ), 



<53> 



<54> 



<55> 



12 ] TDC(GS(D d , 1,-1)) =5(-A l G-A 0 ), 
13] ^(GS^-U)) =3(A O 0A 1 ), 
14] TI)C(GS(D d , -1,-1)) =6>U 0 ©-A l ), 
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<56> u ^ ^*vai 14# %v 2 ^ i ^ o. £ - ^^V^ls i> d ^ cflsfl 

^ *V<>17} 5d4. 

<57> ^Sj-Al 7 o]]A^ 103). 12^1 Ai ^ofl-g-*] . 

<58> 51 3^8- ^S^i^l ^^V-i; ol-g.*M ^ ^l^lSiolrf. 

<59> £ 3a^ t5.<#^ ^cHU^l^-. £ 3b^ SLZ**$ 3-<#4\ #*IMtk £ 3c ^ ^Hll-S] 

U-^lS. D *o]t\-. 51 3dfe «-afl£] HUMls. ^14. 
<eo> i),=5 0 yj)^ nfl 

51 3e^ QStD«i.i)o^ ^joj-ol cf. 

£ 3f^r OS(i>. 1.-1)^1 ^^o]rf. 

<63> E 3g i=. £ 3e^ <*<3*h§- ^-g-tb ^>7lja*>7> 

4. 

<64> 51 3hfe 51 3f^ ^^ofl w 0 V^51^ *»<£*M- ^-g-tb ^4^- 7>7liHxl-7> 



<61> 



<62> 



<65> 



51 3i^ racccsw> tl i.i» s ^o. ^j^o.^. ^o®A^ £401 tj.. oj^ £ 4a^ll^^^ 
.*H -A l0 ] A 0 cq sqjjLo)]^ &o) -g-*i + 01^ c-space obstacle°lcf . 
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#*fl ^iol A 0 o} vflJjLofl^ ^ ^ol - oi^ c-space obstacle^. 

<68> 7^^5(^^,-1,-1)) =^0©-^,)^ A lo] A 0 o] ^h.- ^ # o^ol -g-^ 

c-space obstacle°lcf . 

<69> £ 4c^ ^acS(i),,-U)) ^SUoG^^ -^ io1 Acs] ^j*- £o] 

^-^^ 4 1 c-space obstacle^ cf. 

<70> vyol |ofltoli| ^.^y} 3.<#o) ^-C.q- S7 l7]- ^ aj-^^o} ^Jg.o] 

<?1> [-trVAi 15] TVC(GS(D v a t IV) =d(aA 0 ©Ml), 

[^ai 16] Ti)C(GS(D s ,^-^) =5(^ 0 0-Mi), 

<?3> [^^17] TZ?C(G^{-a ; /?))=a(/?40-^ o ), 

<?4> [-^-ai 18] TDC(GS(D S , -<?,-/?)) =d(-aA 0 
<75> -e-A^^l ^*Vai o. ^. o] + ^ 

<?6> [^Al 19] TDC(GS{D d , *,/?)) = d(- aA&fiA 0, 



<72> 



<77> 

[-^ai 20] TLC(GS(D d ,a,-M = d(/lA & - aA{) , 
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<78> 21] TO^-^^^^i).. 

<?9> 22] ^(^-^-(S^^-Mi), 

<80> -§--§- -^HH-^r ^-3iol^ #^1^ s>]^o] ^-o f-ei^ cjm 51 

^(convex hull)°-3. nfl<0 7)1^*}^ ^^-7> ^4. Hth &| *V cfls. s^o. ^ 

1-<H, ^(circle)'?] ^-f ^SH^l <£^V #3] ^7fl^£- #^(^o)S] 2]-^ 

<83> 23] ^=*o)W WO 

<84> 

24] TZ)C(GS<Al,/!(d))=3(A o ®(tf<0 .A L ))=OJfi(d) 
<85> [-^ 25] TDC(GS(D,l-R(i)))=d(A (l e(-R(t)-A{))=O e Wt)) 

^ Rif)^ # ^ 7> ^ ofll . iq^A-l ^1- &o] 0.310^ - cl^ ^ 

5-1- ^ol*Vcf. ^^((^(d)^^ 2*o_ s ^^lol^ A 0 2} ^l-o] ^tb^. 

O fi ((Md) fe a].^ Mi)^- -§-^7} ^-o]] # ^L 0 o^ ifl^-ofl^ $o] <^ - oi^ ^ 
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<89> 51 5tt t 5L<#^ ;E^(^oH tfl*)H ^«Vai 23<^1^ 25* ol-g-^H 

9] iLH'i ^^]^o]c}. £ 5c £ 5d^ zj-z* £ 5a^- J£ 5b» n J ^3 iflJjL 
^-|- «iMtf. £ 5c^ £ 5dS] 2.^. o^jls-^ ^*vai 232] ^^-« 0 >^]£» 7flA}-g- 

^ =^«H 24^ 251- ol-g-^H Xl^*>5i^. ^fl/^Jf 

<90> ^1^>, S^^^r ^ 3>fl*H 7fl t ^ Tjl^V^o) ^-cf. o]^ 7)^0] <4 

^T?>, 7}^}$] n}zLjL Bel^ y o^°l 

<9i> S. 6^ cf^tV ^^(off set) ^Hd«-^ ii^tf. #^ 



oi^^cf .(S201) 

<94> <^«K£- * 0 >ofl# ^ tij-^x)^ ^^tbcf.(S202) 

<95> 7)1^*}- = H cK^l S.» ^W.(S203) 

<96> °J^«>^ 2.^ Enfls. H7l# ^tW. £L7l^r ¥ ^ ^ 

SL**j\o] o.^ ^flo] 37l( Md)^- ^t.VcK(S204) 
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<97> SL<$3)- 3.7)7} ^^H, <£*}2) ^(^, ^ tci^ >f^)# 

^^4. ol #7^, ^-f ^ Hl^r ifl^- £^ch(S205) 

<98> ^^fl^] <£a]-o} f^ojj 4^ ^VaI 15o1 l^ 22 f^H 2}^*)- ^ ^ai^H 

^.^§1 ^.n^ <2^<y 24M- 25°1H 3j-§- &t±. (S206) 

<99> TDC <S^H sfl<3-t!-i=K ^, #31 206^] oJ^XI a]] 5.0. wj-i£xji= 

^^^> ^ -EE^^I 331^ <2°1\H4.(S207) 

<ioo> ZL^Jl, £ ^Tfl 203°iH ^ «oH^l£» *fl-4-€-*Rr ^4-, #31 204^1 

7fl Al^t!:Cf.(S208) 

<ioi> oJaj-oH^ *g^o] 2*>€ ^3" ^S. ^W^£r lln^l 



«J}Ei^ a7 | ^ A] } S o. ^ H o V^xl 51 # #1"^ ^flS-g- «j-^l£5.^-Ei 

c-space obstacle^ ^3l^^8: Tfl-tV^- =^ £>t}. 

zl ^4, ^-6fl#<Hl tfl«fl^ c-space obstacle^] cfl^ 7ls>*)-^<y o]-g-^>c^ 

4^>^L <HbJ£ $-5L-5\x) <&JL, ifl^ Jf ^^S.^ cf^tb 37H tfl 
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1] 

^4 ^«ii 5fl°H. 

XI l^Tfl; 

#^oil cflsfl zfz}- IKM^ ^^Rr XI 2#7ll; 

A oM ^-^#4 #X)^ 3.711- * «]^ = i7l «3*!~g- ^t^Rr Xl 3#X1; 

A o v 7l Xl 2#7lHH ^-°fl#^- #Xl zj-z*^ ^IMS.* «oHM£°11 tfl*IM 

^f^^l 3-7\^l <3*V-g; ^SRr Xl 4^7jl; 

A o v 7l 4#XHH =^n^. ^t^Hl tfl*H ^ XI Til- ^o^av^- 5>ji, Bel 

D J £#-8- *><^ ^ ISf ^*Kr Xl 5^X1; £ 

ti o v ^l£l- ^ ^ 37l7> 4^ # 0 ti# £ #XH cfl^fl 

*i c-space obstacle^- Xl^}-^ z\) 6^X1; 

2] 

XI 1%H1 SM^ t XI 4^X1tt, 

M-i- (A)*)- #Xl(B)ofl cfltb ^^^^71 ^^>Sl IX]^* cf^-^l ^f^ojj ^*fl 
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d(A 0 ®A{) 
= TRIM(dA o * dA L ) 
= TDC(D 0 U JDJ 
= TDC(GS(D 0 W J> lt 1,1)) 
= TDC(GS(D S ,\,D), 



°J7H, GStt 371^^ ^^^131, W * fe wv^jt^ ^^-olJl, TRIM 

£ 331^H ^ti^r ^7lJE^|- ^^il*V JfJg..fr ^T^Rr ^^U, 1,1-8: 3 

3] 

^fll- (A) 4 #*H(-B)4| tfltb ^SH^7l o^S] ^31^ ^flHW "^fl 



d(A 0 G(-AO) 
= dUAtm-AO)*) 

= TRIM((dA% *d(-A l ) c ) 

= TDCaDZU „(-Z) 1 )) c ) 

= TJX:(GS(D 0 U J> lt 1,-1)) 

= TDC(GS(D S , 1,-1)), 



°i 7 H , GS^ ZL-g-^-fl 3.7)3,^ ^°)Ji, W «o v ^^l5L^ TRIM 
£r ^3l^H ^*fl*Rr X>7l JH^> ^-o} aflT^Vfe 1,-1-g: ZL#^ 3 

71 <g^-ol ol^oj 



27-19 



102W30097011 2004/1/15 
4] 

1 } D = DM{A 0 ) y 1) 

2) TDCiGSiD, l,R(t)))=d(A 0 ®(R(t) - A L )) = O^Rit)) 

3) TDC{GS{D, 1,-Rit))) =d(A 0 Q(-R(t) -A{))= O s (R(t)) 

5] 

xi^ofl c}]t!- ^--i-^Hd ^-i- ^.f-^ a.7is^ <3^Rr #311- ^*}-7| *H 

€• tl^rl" ^>-g-^ Hf-^ H7l2:^ <3^H 7flA>-g-%V ^ olns 4-l#7fl« ^ 

[^t 1 * 6] 

5%H1 54^1 , #7l 4-l#^^, 

1} TDC(GS<i) s , 1,1)) =dU 0 eA 1 ). 

2) TDC(GS(D s ,l, — 1)) = 6>U 0 0-^), 
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Z) TDC{GS{D S , -1,1)) =d(A l G-A 0 ), 
4) ^5(^,-1,-1)) =d(-A 0 @-A{), 



5) Ti)C(GS( J D </ , 1,1)) =d(-A 0 BA ] ), 

g) Ti^CG^^, 1,-1)) =5(-A 1 G-A 0 ), 

7) rDCCGS 1 ^, -1,1)) =3(A O 0A 1 ), 

8) TZTCGSd)^ -l.-l)) =d(A 0 @-A l ), 

a o v 7 ] ni^a^l o^av^) aj-g-s!^ nf^ H7ls^ 47>X] °l^-§r 

zj-zjvfcl.l.l.-l. -1.1. 

7] 

5%H1 ^ol^ , ^-71 4-l^Tfl^ 
^cH-i-Sf #^1^1 3.7171- Z}-z| a<2\- ^ i Cf^-o) ^-ol 47^ 

H^7i ^-iV-i-si ^l*}** 3.71 oil ^&°1 ^^^ije-i- ^}-g-*V^ 31^}^r ^ 
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TLC(GS(D s ,a,fi)) =d(*A 0 ©Mi). 
2) TLC(GS(D s ,<z,-/3)) =d(aA 0 Q-fiAJ, 
3) TDC(GS(D m i-a,P)) = d(pA x Q - <xA Q ) , 



5) TDC{GS{D d , a, ft) = d{- aA <®fiA L ) , 
g) TDC{GS{D d ,a,-fi)) =d(fiA l G-aA l ), 
7 TDC(GS(D * -a.fi)) =d(*A <@fiA L ) , 

g) T£C(GS(D d , -a,- fi)) = d(aA 0 @ - M i) . 0 j ^ 

#7l ^-g-S|^- 3.71^ o^o] 47^1 o)^=-§. z}- 

z^a.fi, a,-fi, -aj, -a.-fi^ ^j. 

[^t 1 * 8] 

*H 1^ 7%H1 71^^ 2*V€ ^ 3^. ^^^-i: ^^HH ^«8Al?l7l 
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1] 
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[S. 4] 
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Rmin 
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